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Abstract 

A variational-vector calculus approach is employed to derive a recursive formulation 
for dynamic analysis of flexible multibody systems. Kinematic relationships for adjacent 
flexible bodies are derived in a companion paper [7], using a state vector notation that 
represents translational and rotational components simultaneously. Cartesian generalized 
coordinates are assigned for all body and joint reference frames, to explicitly formulate 
deformation kinematics under small deformation assumptions. Relative coordinate kinematics 
for joints are decoupled from deformation kinematics and an efficient flexible dynamics 
recursive algorithm is developed. Dynamic analysis of a closed loop robot is performed to 
illustrate efficiency of the algorithm. 

1. Introduction 

A recursive dynamics formulation was proposed by Armstrong [1 ] to analyze a robot 
manipulator, beginning with Cartesian equations of motion in a joint reference frame. 

Reaction forces were introduced as unknown forces into the equations of motion. These 
unknown forces were then eliminated to obtain recursion formulas for calculation of reduced 
equations of motion. The method was reformulated by Featherstone [2] and used to analyze a 
robot arm that consists of revolute and/or translational joints. He used a spatial notation to 
relieve notational complexity and introduced a new "articulated inertia" terminology that 
reflects inertia effects of all outboard bodies in a kinematic chain. Neither method considered 
the effect of flexibility of components. 

Variational approaches have dominated structural analysis for the last decade. The 
variational method has recently been combined with vector calculus, to permit systematical 
transformation of the equations of motion from Cartesian space to joint coordinate space [3]. 
The same variational approach was used to derive a recursive formulation for constrained 
rigid body mechanical system dynamics in Ref. 4. 

A variational equation of motion for constrained flexible systems was derived in Ref. 5, 
using Cartesian coordinates. The variational approach was applied to extend the rigid body 
recursive formulation to flexible body systems by Kim [6]. Kinematic relationships between 
reference frames for a pair of bodies that are connected by a joint are expressed in terms of 
joint relative coordinates and modal deformation coordinates of bodies. As a result, joint and 
modal coordinate equations of motion are coupled and must be solved simultaneously. This 
requires inversion of a moderately large matrix, for coupled modal and joint coordinates. 

In order to enhance graph theoretic analysis of deformation characteristics, kinematics 
of flexible multibody systems is represented in a companion paper [7]. Based on this 
kinematic analysis, a recursive formulation for dynamic analysis is represented in this paper 
that decouples relative joint and deformation coordinates, to improve computational efficiency. 
The proposed formulation can be used with a rigid body formulation by eliminating terms 
related to modal coordinates, due to its decoupled treatment of gross motion and deformation. 
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State vector representations and kinematics of flexible multibody systems, defined in 
Refs. 8 and 7 respectively, are summarized in Section 2. The equation of motion for a flexible 
body is transformed from the Cartesian space to a state space setting in Section 3. System 
topology is defined in Section 4 and recursive equations of motion for a single closed loop 
subsystem are derived in Section 5. Cut joint constraint acceleration equations that are needed 
in the equations of motion are derived in Section 6. The base body equation of motion is defined 
in Section 7. Numerical examples and results are presented in Section 8. 

2. Decoupled Recursive Relationships for Flexible Bodies 

To derive the variational equations of motion, state vector notation and decoupled 
recursive relationships for adjacent reference frames [7, 8] are briefly reviewed here. A 
matrix representation of the Cartesian velocity of a reference frame with origin at point P , as 

shown in Fig. 1 , is given as Y p = [rj to J] T , where rj is the velocity of point P and o) p is the 
angular velocity of the x p - y p -Zp body reference frame. A generalized velocity state vector ? p , 
based on screw and motor algebra [8, 9], is defined here as 


l 'p + ' r p®p 

0)n 


= T p Y p - T d 


I CD„ 

L p 


where the 6x6 nonsingular matrix T p is defined as 

1 r Y 

0 I 

The tilde operator is used here to define a skew symmetric matrix as 
r z r y ~ 

-r v 


r - , , x 

-r y r x 0 

that is associated with a vector r = [r x ,r y ,r 2 ] T . 

The Cartesian virtual displacement 8Z is defined as 


(2.1) 


(2.2) 


(2.3) 


8Z p , 


8r P 

8jc, 


pj 


(2.4) 


where 8r p is virtual displacement of point P and 8rc p is virtual rotation of the x p - y p -z p frame. 

The state variation can be obtained by replacing r p and oip by 8r p and 8jCp, respectively, in Eq. 
2.1; i.e., 


8Z p s 


8 r p + r p§Xp 


8jc„ 


= T p 8Z p 


(2.5) 


The acceleration state vector Y p is defined as the time derivative of velocity state Y p of 
Eq. 2.1; i.e., 



r p + r p <flp + fpCOp 


= T p Y p + X p 


CO 


P 


( 2 . 6 ) 
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where X p is the 6x1 vector 


X p = 


r P (0 P 

0 . 


TU . . (2.7) 

The inverse relationships between Cartesian and state vector quantities can be derived from 
Eqs. 2.1, 2.5, and 2.6 as 


5Zp = T^8Z p 
Y = T 1 Y - X 

'p 'p *p A p 

where the 6x6 inverse matrix Tp 1 of the matrix T p is simply 


( 2 . 11 ) 

Three flexible bodies, with their body and joint reference frames, are shown in Fig. 2. 
The x-y-z frame is the global reference frame, denoted as F. Two joint reference frames are 
attached to a body i at each joint definition point P^. The x^-y'jj-z jj frame, denoted as F~, is 
fixed to body i and is parallel to the x’ r y ‘ r z'j frame, denoted as Fj, in the undeformed state. The 
x,j- y^- Zy frame, denoted as F^, is body fixed and has fixed orientation, relative to the F-’ 

frame, since both are fixed to the body at the same joint definition point where the body is 
assumed to be very stiff. 

Recursive relationships between reference frames in a joint, for example, between the 
xfj- yjj- Zjj and Xj" r y^- Zj- frames of joint (i,j), are 



( 2 . 8 ) 

(2.9) 

( 2 . 10 ) 


X|i ~ ^ij + n yqij 

8Zjj =SZjj + ITjj8qjj 
X|i = ^ij + n y qjj + 0jj 


( 2 . 12 ) 

(2.13) 

(2.14) 


where Y, Y, and §Z are state representations of velocity, acceleration, an d v irtual 
displacement, respectively, and q^ is a vector of joint relative coordinates [7]. 

Recursive relationships between inboard and outboard joint reference frames of a 
flexible body are 


Yy - Yj /+ r jja j 
8Z y = 8Zj/ + TjjSaj 


( 2.1 5 ) 
(2.16) 


Yu = Y;j 


Fjja j + 


An 


(2.17) 


where a is the deformation modal coordinate vector of the flexible body [5-7]. 

The recursive relationships between frames Fj and F s of a flexible body are 
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Y|j = Yj + Ajja j 

( 2 , 18 ) 

5 Zjj = 8 Zj + AjjOj 

( 2 . 19 ) 

Yjj = Yj + Ajja'j + Ejj 

( 2 . 20 ) 


Detailed expressions for matrices Ty, Ay, n jjr ©y, Ay, and Hy may be found in Ref. 7. 

3. Equation of Motion for a Flexible Body 

The variational Cartesian equations of motion for a flexible multibody system are 
derived in Ref. 5. They can be written for a typical body i, using the notations defined in 
Section 2, as 


[sz^ 5a/} 




+ Sj + Vj - Qj l = 0 


( 3 . 1 ) 


which must hold for all kinematically admissible 5Zj and 5a;. The mass matrix Mj is a 
function of the generalized coordinates, Sj is a collection of quadratic velocity terms, Vj is the 
elastic generalized force, and Qj is the applied generalized force. 

The equations of motion in Cartesian space are transformed to state vector form by 
substituting kinematic relationships between the spaces. The state variation and acceleration 
relationships of Eqs. 2.9 and 2.10 are substituted into Eq. 3.1, to yield 


[szj 5a/V 


r 

" 

1 

Mj 

Yj 

-Qj - 


Sj 



= 0 


(3.2) 

where the state representation M ( of the mass matrix is partitioned into 4 submatrices, based 
on state and modal coordinates, 


Mi 


■ ■ mm ii m3 
M; M; 


m!™ m 


aa 


TT 1 0 

0 I 


M; 


T7 1 0 
0 I 


(3.3) 


Similarly, the state representation of Qj, which accounts for generalized force and coupling 
terms, is divided into two subvectors as 




cf 


Tj 1 0 

v 

Mj 

Xj 

-Sj-Vj+Qj 

Gf. 


. 0 1 . 

V 

.0 . 

/ 


(3.4) 


The equations of motion in Eq. 3.2 can be rewritten, using the notations of Eqs. 3.3 and 3.4, as 


5Z j r (Mj T ' m Y i + - Qf) + Sa/fM^Yj + M® a, - Qj ) = 0 

where 5Zj and 8aj must be consistent with all constraints that act on body i. 


(3.5) 


4. System Topology 

An extended flexible multibody graph model, in which nodes represent reference 
frames and edges represent transformations between frames, is presented in Ref. 7. The 
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corresponding graph for a single closed loop system is shown in Fig. 3. Body / is the junction 
body, at which chains 1 and 2 of the spanning tree of Fig. 4 meet. If joint J(n,n+1) between 
bodies n and n+1 is cut, both bodies n and n+1 are treated as tree end bodies. 

5. Equations of Motion of a Single Closed Loop 

The variational equation of motion for the system shown in Fig. 3 is 


m 

£{Szj r (M[ nm Y i + M™*, - Qf) + SafcMf" 1 *; + M®a. - Of)} = 0 

i=/ , (5.1) 

which must hold for all kinematically admissible virtual displacements that satisfy joint and 
deformation constraints in Fig. 3. 

State variation and accelerations of each body reference frame are expressed in 
corresponding joint terms and modal coordinates from Eqs. 2.19 and 2.20 and substituted into 
Eq. 5.1. The resulting equations of motion are as follows: 


m 




1) 


wry; 


i(M) 


M ma^ 

i a i 


Qf) + Sa T (Mf m Yi 


iCi-1) 


..aa-- 

+ M; ai 


Qf)} 


i=/ 

= EQM(1 ) + EQM(2) = 0 (5 2) 

which must hold for all kinematically admissible virtual displacements. Terms arising in Eq. 
5.2 are as follows: 


M m m ..mm 

i = M i 

i«ma ..ma . . m m . 

M i = M i - M i A i(M) 

M am = M^ aT 

,aa - aa .-.am , 


M r= *r- ^v 1 )+A^ 1) (Mrv 1 )-“. n ") 

Qf=Qf + ^ 

Of = Qf + - Aj M) (Qf + M^S^p 


(5.3) 


EQM(1 ) = X { ^Vi) ( “r ViJ+MTar^ ^(Mj™ Vi^apCf)} 


i=/ 

m 


EQM(2) = ]T Sa)(Mf a V, )+ Mfi r cf» 


i=n+1 


(5.4) 


(5.5) 


The Jacobian matrix of the cut joint constraint function o J(n,n+1> is obtained by 
differentiation as 


5 = ^nO* .1, 8Zn(n+1)+ 0i (n + ,)n 6 (n+1)n = 0 


(5.6) 
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where state variations 8Z n(n+1) and 8Z (n+1)n are obtained by employing the state vector 
representation of Cartesian virtual displacements. There exists a Lagrange multiplier vector 
such that 

n 

EQM(2) + ^{SZ^ 1 /M[^Y i(j _ 1) +M[ na a r Cf) 
i=/ 




-aa 


4T 


x" (n+1) = o 


n(n+1) 


(5.7) 


where the virtual displacements need only be consistent with kinematic admissibility 
conditions for all tree structure joints and deformation constraints. Similarly, the equation 
motion for chain 2 is 


of 


m 


EQM(2) - X 


Nn+1 


irKm-D 


_ (5 . 8) 

The virtual displacement 8Z n(n+1) may be expressed in terms of SZ n{n . n and 5a n from 
Eq. 2.16. Substituting this relationship into Eq. 5.7, to obtain 

n-1 

EQM(2) + X {5 ^Ki-l) (M !^^(i-i) +M r a ®i^ Z)+ 

i=/ 

- ><./“”> - 1 » ( 5 . , , 

which must hold for all virtual displacements that are consistent with tree structure joints 
and deformation constraints in Fig. 4. Since 5a n is arbitrary, the coefficient of 8a„ in Eq. 5.9 

must be zero. As a result, the following expression for a n is obtained: 


l n(n-1) Y n(n-1) + R n(n-1) + R n(n-1)* 


(5.10) 


where 


R n(n-1 ) = *<r’ f 0C 

R n(n-1) = _M n (5.11) 

Note that superscript n(n+1) for the Lagrange multiplier vector has been dropped, for 
notational convenience. 

Substituting the modal acceleration of body n from Eq. 5.10 into Eq. 5.9, 
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n-1 


EQM<2)+X{SZ; M) (MrY i , j _, )+ M™i | ^8a>r^ 1 )*“f a ii-^)l 


i =/ 


+ ®^n(n~1) (G kr>-1)^n(n-1) _G S(n-1) + ^i(n-1)^ “ 0 


where 


z u»mm ■ ■ m 3 i^z 

f)(n-1) = "”n + ™n R rr(n-1) 


«* 


i(n— 1) 


O! U-1) 


<wi)=*L +<x 


(5.12) 


T 
C 

u n(m-1) " ,n(n_1) 

and Eqs. 5.9 and 5.12 have the same kinematic admissibility conditions. 

The variational equations of motion can be reduced further by substituting S^ n(ri . 1) and 


(5.13) 


Y n(n-i) in te rm s of SZ (n . 1)n , 5q (n . 1)n , Y (n _ 1)n , and <*n_ 1)n , employing Eqs. 2.13 and 2.14. 
5.12 thus becomes 

H— 1 '• ' • : ' z — — 


EQM( 2 ) + ^{8zJ i . 

\=l 


i)(M j mm Y i ( j _i)+M| na a j -q z )+5a j r (Mf rT1 Y i 




Equation 


+ ^ (n-1 )n^^n(n-1 )\n-1 )n‘ f ^h(n-1 )^(n-1 )n*Wl )n 

T 

"^nCn-D® (n-1)n ^n(n-1) + ^i(n-1)^ 


+ ^(rvl )n^\n-1 )n^^n(n-1 ) Y (n-1 )n + ^h(n-1 )^n-1 )rfl(r>-1)n 

T 

"^htn-1 )® (n-1 )n~^i(n-1 ) + ^i(rH 1 = ® (5.14) 

which must hold for all virtual displacements that satisfy constraints inboard of body n-1. 
Since the kinematic relationship for joint (n-1 ,n) has been substituted into the equations of 
motion, 5 Vl)n is arbitrary; i.e., the coefficient of 8q (n _ 1)n in Eq. 5.14 must be zero, which 
gives 


„ 2 3 c 

fltn-Dn = R (n-1)n Y (n-1)n + R (n-1)n + R (rv1)n^ 

where 

R (n-1)n = “(r^vDnPhCn-D^n-Dn^ ^rv-Dn^ntrvI) 

R (n-1 )n = “(t^v-DnGhtn-lAn-Dn^ I ^r>-1)n ( Qn(rv-1)®n(r)-1)'^(r>-1)^ 
R (n-1)n = -(^n-DnPntn-D^n-Dn) ^n-UnQrrfrv-l) 


(5.15) 


(5.16) 


where existence of 1 is proved in Ref. 1 1 . Note that the subscripts of R z , 

R a , and R c in Eq. 5.16 are in ascending order which are different from Eq. 5.11. 

Substituting the relative Joint acceleration of Eq. 5.15 into Eq. 5.14, 
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n-1 


EQM(2) + X(8zLi) (M rY i (i-i)+Mra i ^ Z >+^>? m Y i o-i)+Mrai^ a » 


i=/ 


+ ^(TKl)n^^n-1)n^(rv1)n _ ^rv-1)n H, ^n-1)n^ ~ ® 


( 5 . 17 ) 


where 


®(n-1)n ” ®n(n-1) + ®n(r>-1)^(rv-1)n^>-1)n 

®?n-1)n ~ ®n(n-1) “ ®n(n-1)®(rv-1)n ” ®n(n-1)^(rv1)n^(r>-1)n 
T T c T 

Q(n-1)n = ®n(n-1) + ®n(n-1)^n-1)n^(n-1)n (5.18) 

which must hold for all virtual displacements that satisfy the same kinematic admissibility 
conditions as Eq. 5.14. Note that the subscripts of G z , G q , and G c in Eq. 5.18 are in ascending 
order which are different from Eq. 5. 13. 

By employing the recursive relationships between inboard and outboard joint frames 
of Eqs. 2.16 and 2.17, the variational equations of motion can be reduced to 


n-2 


EQM(2) + ^{8zJ i _ 1) (M[ nm Y i(i _ 1) +Mf m a r q z )+ 8af(Mf m Y| 0 _ 1) +Mf a apCf)} 


hi 


+ SZ J,_i )n^(n-1 Xn-2) + ^(n-1 )r$n- 1 + An-1 )n> 

)n^n-1)n^ M rvTY (n-1)(rv-2) +M n?l ) 

+ 5a [T (Vi )n^n-1 ) n ^ (n-1 )(n-2) +I Vl )rAi-1 ‘ t Ar>-1)n> 

“^>-1 Jn+Gfn-I kiW + M ^ Y (rv1 )(n_2) +M rM 8 r >-1 1 1 = 0 ( 5 . 19 ) 

which must hold for all virtual displacements that are consistent with tree structure 
constraints inboard of joint (n-2,n-1). Since 8a n 1 must be arbitrary, the coefficient of 

Sa^ must be zero, which yields 


where 


a n _i = R (n-1 )(n-2) Y(r>-1 )(n-2) +R fn-1 )(n-2) +F *Cr>-1 Xn-2)* 

RjvIXn-a - 

R *n-1)(n-2) = -(M“ 1 +r (n-DnGf^! )n r (rHl )n ) OV^y/G^ jrArv-Dn+^n-l )n)"A >-1 J 


(5.20) 


Mn-1)(n-2) 


“ ^ n-1 + ^(n-1 )n^n- 1 )n^(n— 1 )r? ^(n-1 )n^r>-1 )n^ 


( 5 . 21 ) 


where existence of (M“ 1 +rJ v1)n G^ > . 1 ) n r( r> _ 1 ) n ) 1 is proved in Ref. 11. 

Substituting the modal acceleration of body n-1 from Eq. 5.20 into Eq. 5.19, 
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n-2 


EQM(2) + ^{5zJ i _ 1) ( M l mm Yi( j _i)+Mf m a i -q z )+ 5a^M 3m Y i(M) +M? a a;-q a )} 


i=/ 


where 


(5.22) 


+ ^J>-1Xrv-2)(®(r>-1 )(n-2)^(n-1)(n-2)^?n- 1 )(n-2) + ^[n-1 Xn-2)^ = 0 
Gta-.xn-a - 

Gfn-IKn-S = GSHl)n<<tl-«3fn-1)n r (n-1)n + W!ri> R ?n-1)(i>-3 

c T c 1 

®(n-1Xn-2) = G (n-Un' + ^ G fn-1 )n^(n-1 )n + ^i-1 ) R (n-1Xn-2) (5.23) 

If the reduction procedure is continued to the junction body / for chains 1 and 2, the 
following reduced variational equation of motions is obtained: 

8 ^X^i)((^/fi) 4 ^ ) ^ M) -KG^ /f1) r^ 1) +G^ n r hl )a^<G^ fr1) A Wt . 1) +<^ n A /rT1 ) 

+ baj {(r J KM) <? KM) +r JnGj^Y <M)+(r 'J M) i >r ^o+r^Gj^r ^ay 

+ ( r <A-1 )^/f 1 A(M ) +r *n G /m A *n )_(r I/t-1 ) G X/f 1 ) +r *n G *n^r J^G ) 

WMf ^rQf} = 0 (5 24) 

Since 5a r is arbitrary, the modal acceleration of junction body / can be determined as 


a /= R </f1) Y «-1)+ R XM) 


+ R 


<MX 


where 


(5.25) 


rZ */- 1) = “( M / a+r I/f1) G X/+1) r XA-1) +r ^ G L r iTi) ( M 3 m +rJ /f 1 jGj^ j+T^G^) 

r xm) = -< M r +r ki ADr^D+r^G^r^) 

+ r lM) (G tn A »r +G !n>- Q ?) . 

«Sm) = -<wf +rI M) (4 1) r (fr1) +r^(4,r hl r , (rI fc , ) GSl 1 ^GL) (5 . 26 > 

Substituting the modal acceleration of the junction body from Eq. 5.25 into Eq. 5.24, 

SzIm)( ( 4i)Vi) - G XM) + Gxm A ) - 0 (5.27) 

which must hold for all kinematic constraints acting on junction body /. Terms arising in Eq. 
5.27 are as follows: 

eiU - (GjM)^<4>tMr^ k1) r,fr 1) +G^r ta+ M7 a )R; M) 

®8m) = 


<*m> = 


(5.28) 
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6. Cut Joint Constraint Acceleration Equations 

In addition to the equations of motion, cut joint constraints must be used to obtain the 
same number of equations as unknown accelerations and multipliers. Cut joint constraints 
may be differentiated twice to obtain the constraint acceleration equation, 


^(n.n+1) = 


n(rHl) 


r n(n+1) 


+ ®Z Y - 

^(rnOn 


(n+1)n 


-y= o 


(6.1) 


where y is the collection of all terms that do not include Y,^) and Superscript 

(n,n+1), which has been used to denote the cut constraint between bodies n and n+1, is 

omitted for notational convenience in the derivation. Accelerations Y^d and Y^^ from Eq. 
2.17 are substituted into Eq. 6.1, to yield 


Z rtrH , ft tin-1 )+ r n(r>4-1 )3n +A n(rH-1 )> 

+ (rH-1)(rH2) +r (rv+1 >(m-2AH-1 +r (n+1 )(m-2p “ Y= 0 (6.2) 

Substituting a n from Eq. 5.10 and a^, obtained by advancing subscripts in Eq. 5.10, into Eq. 
6.2 yields 


C a c ■* J J 

Q-i(n-1)nYn(n-1) + G(m-1)(m-2)^(m-1)0>+Z) + (^-n(n-1) + L(f>f1XrH2)^ 

_ ^n(n-l) - ^(n+IKn+2) “ Y = 0 (6.3) 

where 

^-n(n-l) = ^Z^^nCrn-'O^nCn-l) 

Nn(n-I) = -*Z n(rM , ^Ai(th- 1 ) + ^n(r>f 1 )^n(r>-1 P (6.4) 

and L (n+1)(n+2) and N (n+1)(n+2J are obtained by substituting appropriate subscripts into Eq. 6.4. 

The recursive relationship between triple primed Trames of joints (n-1,n) and 
(n+2,n+1), obtained from Eq. 2.16, are next substituted into Eq. 6.3, to give 


Gn(n-1)(Y (n-1 )n +I \r>-1 )nd(n-1 )n+^(rv-1 )n^rHl )(rn-2)(Y (m-2XrH-1 ) +I Wxm-1)<i(r>f 2)(m-1 ) 

^(rn-2)(m-1) W C(rv1) + ^1XrH2) ) ^n(n-ir N (n+1Mm-2)‘ J y = 0 (6.5) 

If the relative joint accelerations from Eq. 5.15 and qjn+axrH-i). obtained by replacing 
subscripts of Eq. 5.15, are substituted into Eq. 6.5, 

= 0 ( 6 . 6 ) 

where 


SOI 



N (n-1)n - N n(n-1) + Gn(n-1)(®(n-1)n + ^n-1)n R fn-1)n^ 

T T C T 

*-(n-1)n = ^n(n-1) + ®n(n-1)^n-1)n^(n-1)n (6.7) 

and L (n+2)(n+1) and N (n+2)(n+1) are obtained by replacing (n-l.n) by (n+2,n+1) in Eq. 6.7. 

If this sequence of elimination of modal and relative joint accelerations is repeated to 
junction body /, the following reduced constraint acceleration equations are obtained as 

®W-1)^W-1) + l'W-1)^’ - 1 ) Y = 0 (6.8) 

where 

T T T T 

L /CM) = ( L C/f1) +L *n) + (G/C/fl At+1) +G An r /hi) R A/-1) 

N KM) = ( N X/f1) +N An)“ (%1) r ((/f1) +G tn r »n )R </-1) ' (%1)%1) +G *ny (6.9) 

7. Base Body Equation of Motion 

A single closed loop subsystem is used to derive decoupled recursive equations of 
motion in Sections 5 and 6. The variational equations of motion were* redu ce d to the inboard 
joint reference frame of the junction body. Since the base body does not have an inboard joint, 
the inboard joint reference frame of the base body is assumed to coincide with the base body 
reference frame. If the reduction procedures that have been carried out with this subsystem 
are repeated along all chains of a system to the base body, the base body equation of motion is 
obtained as 


(71) 

where 8Z b is arbitrary for a floating base body, which yields 

o (7 . 2) 

Reduction of cut joint constraint acceleration equations to the base body yields the 
reduced constraint acceleration equations as 

' 0 ,7. 3) 

Equation 7.2 may be combined with Eq. 7.3, to form the augmented base body equations of 
motion, 


T lr 



(7.4) 


In the case of a constrained base body, a Lagrange multiplier vector X b and 
corresponding constraint accelerations are introduced into Eq. 7.4. The resulting augmented 
equation of motion is 
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where $ b is constraint equations acting on the base body 


(7.5) 

and f is the collection of all terms 


* vb 

that do not include Y b in ® . 

Equation 7.4 or 7.5 is solved for the base body state acceleration vector and the 
Lagrange multiplier vector. Detailed computational algorithm is presented in Ref. 11, 


8. Example Problem 

A closed loop spatial robot that consists of two flexible and three rigid bodies is shown 
in Fig. 5. Bodies 3 and 5 are flexible beams with rectangular cross sections. All other bodies 
are treated as rigid bodies. Body 1 is connected with ground, which is designated as the base 
body, by a revolute joint. A lumped mass is attached to body 3 at point P to represent a 
payload for this robot. Joints 1,2,3, 4, and 5 are revolute joints. The connection between 
bodies 3 and 5 is a spherical joint (joint 6). 

One generalized coordinate is assigned for each revolute joint, and three deformation 
modes have been chosen for each flexible. Joint 6 is defined as the cut joint to form a tree 
structure. 

Inertial properties and geometric data are given in Table 1. For deformation mode 
computation, flexible beams are discretized in to 10 equal length 3 diemensional beam 
elements. 

Simulation is carried out for 0.5 sec., with the following actuator torques applied at 
joints 1, 2, and 4, respectively: 

n, = 5.0E9-sin(0.27tt) 

n 2 = 9.0E7 - 8.0E7 t 

n 4 = 8.5E9 - 3.0E9 t (8.1) 

Results of the simulation have been verified using the three dimensional dynamic analysis 
program DADS [18], which employes a Cartesian coordinate formulation [13]. In the 
Cartesian coordinate formulation, 48 generalized coordinates and 40 constraint equations are 
needed to represent the system. However, only 1 1 generalized coordinates and 3 constraint 
equations are required for the recursive formulation presented here. The y coordinate, 
velocity, and acceleration of the origin of the body reference frame for body 3 are shown in 
Fig. 6. Both the DADS and recursive formulations yield the same results when implemented on 
a VAX 11/780 serial computer, which cannot exploit parallelism in the recursive algorithm. 
Table 2 shows the CPU time required for both methods and the ratio of CPU time between the 
two methods. 
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Figure 3. A Closed Loop Subsystem 
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Figure 4. Spanning Tree for the Closed Loop Subsystem 
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Table 2. CPU Comparison 


CPU 

Ratio 

DADS 

Recursive Method 

8450 sec. 

762 sec. 

11.09 


Table 2. CPU Comparison 
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